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Description Of The Preferred Embodiment 
10020] i. n the following figures the same reference 
numerals will be used to identify the same components. 
The present invention is preferably used in conjunction 
with a rollover control system for a vehicle. However, 
the present invention may also be used with a deployment 
device such as airbag or roll bar. The present 
invention will be discussed below in terms of preferred 
embodiments relating to an automotive vehicle moving in 
a three-dimensional road terrain. 

£0021] Referring to Figure 1, an automotive vehicle 
10 with a safety system of the present invention is 
illustrated with the various forces and moments thereon 
during a rollover condition. Vehicle 10 has front right 
and front left tires 12a and 12b and rear right tires 
13a and left rear tires 13b respectively. The vehicle 
10 may also have a number of different types of front 
steering systems 14a and rear steering systems 14b 
including having each of the front and rear wheels 
configured with a respective controllable actuator, the 
front and rear wheels having a conventional type system 
in which both of the front wheels are controlled 
together and both of the rear wheels are controlled 
together, a system having conventional front steering 
and independently controllable rear steering for each of 
the wheels or vice versa. Generally, the vehicle has a 
weight represented as Mg at the center of gravity of the 
vehicle, where 9 = 9.8m/^ and M is the total mass of the 
vehicle. 

10022] As mentioned above, the system may also be 
used with active/semi-active suspension systems, anti- 
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roll bar or other safety devices deployed or activated 
upon sensing predetermined dynamic conditions of the 
vehicle. 

[0023] The sensing system 16 is coupled to a control 
system 18. The sensing system 16 preferably uses a 
standard yaw stability control sensor set (including 
lateral accelerometer , yaw rate sensor, steering angle 
sensor and wheel speed sensor) together with a roll rate 
sensor and a longitudinal accelerometer. The various 
sensors will be further described below. The wheel 
speed sensors 20 are mounted at each corner of the 
vehicle, and the rest of the sensors of sensing system 
16 are preferably mounted directly on the center of 
gravity of the vehicle body, along the directions x,y and 
z shown in Figure 1. As those skilled in the art will 
recognize, the frame from b lt b 2 and fc, is called a body 
frame 22, whose origin is located at the center of 
gravity of the car body, with the 6, corresponding to che 
x axis pointing forward, b 2 corresponding to the y axis 
pointing off the driving side (to the left) , and the 6., 
corresponding to che z axis pointing upward. The 
angular rates of the car body are denoted about their 
respective axes as w s for the roll rate, w u for the 
pitch rate and u, for the yaw rate. The present 
invention calculations preferably take place in an 
inertial frame 24 that may be derived from the body 
frame 22 as described below. 

[0024] The angular rate sensors and the 
accelerometers are mounted on the vehicle car body along 
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the body frame directions b,, 6 2 and 6 3 , which are the 
x-y-z axes of the vehicle's sprung mass. 

[0025] The longitudinal acceleration sensor is 
mounted on the car body located at the center of 
gravity, with its sensing direction along 6, -axis, whose 
output is denoted as a* . The lateral acceleration sensor 
is mounted on the car body located at the center of 
gravity, with its sensing direction along & 2 -axis, whose 
output is denoted as a„ . 

[0026] The other frame used in the following 
discussion includes the road frame, as depicted in 
Figure X. The road frame system r,r 2 r 3 is fixed on the 
driven road surface, where the r 3 axis is along the 
average road normal direction computed from the normal 
directions of the four tire/road contact patches. 

[0027] In the following discussion, the Euler angles 
of the body frame with respect to the road frame 

are denoted as 9^ 6^ and e zlir , which are also called 
the relative Euler angles. 

[0028] The present invention estimates the relative 
Euler angles 6+ and 6^ based on the available sensor 

signals and the signals calculated form the measured 
values . 

[0029] Referring now to Figure 2, roll stability 
control system 18 is illustrated in further detail 
having a controller 26 used for receiving information 
from a number of sensors which may include a yaw rate 
sensor 28, a speed sensor 20, a lateral acceleration 
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sensor 32, a roll race sensor 34, a steering angle 
sensor 35, a longitudinal acceleration sensor 36, a 
pitch rate sensor 37 and steering angle position sensor 
39 . 

[0030] In the preferred embodiment only two axial 
rate sensors are used. When two of these axial rates 
are known, the other may be derived using other commonly 
available sensors. 

[0031] That is, pitch rate sensor 37 is illustrated, 
it can be eliminated in the preferred embodiment. 

[0032] In the preferred embodiment the sensors are 

located at the center of gravity of the vehicle. Those 
skilled in the art will recognize that the sensor may 
also be located off the center of gravity and translated 
equivalently thereto. 

[0033] Lateral acceleration, roll orientation and 
speed may be obtained using a global positioning system 

(GPS) . Based upon inputs from the sensors, controller 
26 may control a safety device 38. Depending on the 
desired sensitivity of the system and various other 
factors, not all the sensors 28-37 may be used in a 
commercial embodiment. Safety device 38 may control an 
airbag 40 or a steering actuator or braking actuator at: 
one or more of the wheels 41, 42, 44, 46 of the vehicle. 
Also, other vehicle components such as a suspension 
control 48 may be used to adjust the suspension to 
prevent rollover. 



[0034] Roll rate sensor 34 and pitch rate sensor 37 
may sense the roll condition of the vehicle based on 
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sensing the height of one or more points on the vehicle 
relative to the road surface. Sensors that may be used 
to achieve this include a radar-based proximity sensor, 
a laser-based proximity sensor and a sonar-based 
proximity sensor. 

[0035] Roll rate sensor 34 and pitch rate sensor 3 7 
may also sense the roll condition based -on sensing the 
linear or rotational relative displacement or 
displacement velocity of one or more of the suspension 
chassis components which may include a linear height or 
travel sensor, a rotary height or travel sensor, a wheel 
speed sensor used to look for a change in velocity, a 
steering wheel position sensor, a steering wheel 
velocity sensor and a driver heading command input from 
an electronic component that may include steer by wire 
using a hand wheel or joy stick. 

[0036] The roll condition may also be sensed by 
sensing the force or torque associated with the loading 
condition of one or more suspension or chassis 
components including a pressure transducer in an act of 
air suspension, a shock absorber sensor such as a load 
cell, a strain gauge, the steering system absolute or 
relative motor load, the steering system pressure of the 
hydraulic lines, a tire laterally force sensor or 
sensors, a longitudinal tire force sensor, a vertical 
tire force sensor or a tire sidewall torsion sensor. 

[0037] The roll condition of the vehicle may also be 
established by one or more of the following 
translational or rotational positions, velocities or 
accelerations of the vehicle including a roll gyro, the 
roll rate sensor 34, the yaw rate sensor 28, the lateral 
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acceleration sensor 32, a vertical acceleration sensor, 
a vehicle longitudinal acceleration sensor, lateral or 
vertical speed sensor including a wheel -based speed 
sensor, a radar-based speed sensor, a sonar-based speed 
sensor, a laser-based speed sensor or an optical-based 
speed sensor. 

[0038]. Steering control 38 may control the position 
of the front right wheel actuator 40, the front left 
wheel actuator 42, the rear left wheel actuator 44, and 
the right rear wheel actuator 46. Although as described 
above, two or more of the actuators may be 
simultaneously controlled. For example, in a rack-and- 
pinion system, the two wheels coupled thereto are 
simultaneously controlled. Based on the inputs from 
sensors 28 through 39, controller 26 determines a roll 
condition and controls the steering position of the 
wheels . 

[0039] Speed sensor 30 may be one of a variety of 
speed sensors known to those skilled in the art . For 
example, a suitable speed sensor may include a sensor at 
every wheel that is averaged by . controller 26. 
Preferably, the controller translates the wheel speeds 
into the speed of the vehicle. Yaw rate, steering 
angle, wheel speed and possibly a slip angle estimate at 
each wheel may be translated back to the speed of the 
vehicle at the center of gravity. Various other 
algorithms are known to those skilled in the art . Speed 
may also be obtained from a transmission sensor. For 
example, if speed is determined while speeding up or 
braking around a corner, the lowest or highest wheel 
speed may not be used because of its error. Also, a 
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transmission sensor may be used to determine vehicle 
speed. 

Connecting The Relative Attitudes With The Relative 
Corner Displacements 



present invention first correlates the relative attitude 
with the displacement at each corner of the vehicle. 
Consider a vector with x-y-z coordinates as x^y^z^of its 



coordinator of the end point of the same vector measured 
in the road frame can be computed from the Euler 
transformation 

z T = -x h waxifij,) + y b sin^J cos (*,,„.) + *„ oM(tf -r )coe(0 >h . ) ( 1 ) 

Let / be the half of the wheel track; t f and <,. be the 
distances from the center of gravity of the car body to 
the front and rear axles; h be the distance between che 
bottom of the vehicle body and the center of gravity of 
the vehicle along the body j-axis; • 0^. and 6 yhr are the 
relative roll and pitch angles. Then in the body frame 
the four corners of the vehicle body where suspensions 
are connected with the wheel have the following 
coordination : 



[0040] 



In operation, the method according to the 



end point in the body frame of Figure 1. 



The z 



LF Corner : x = t { , y = I, z = -A 
RF Corner : x = t f , y = -l.z = -h 
LR Corner : x = — t^y = i, z = —h 
RR Corner : x = -t,.,y = -l,z = -h 



(2) 
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Let z v ,z rf ,z lr and z„ be the relative displacements of the 
vehicle corners at the left-front, right-front, left- 
rear and right-rear locations, which are measured along 
the direction perpendicular to the average road surface. 
By using the transformation in Equation (1) , those 
corner displacements relative to the road surface can be 
expressed as the function of the relative roll and pitch 
angles 6 xbr and 0 vir 



^ = -t, sin(^ r ) + l 8 m<^ r )cos(^ r ) + (z cfl - /Ocos(^,.)co S (^,.) 
z rl = -t f sin(^ r ) - l^n(e xbr )co B ($ vlir ) + (z cg - /i)cos(e ii)r )coa(^ r ) 
z lr =t r ain^J + <sin(0 ltr )co 8 (^,.) + - /0 cos (0 iir ) cos (<?„,„.) 
z TT = tr sin(0„ ir ) - 2sin(^ r )cos(^ r ) + (z c „ - A)co 8 (0 l( „.)co S (0 ,„.) 



where z ej) is the relative displacement of the center of 
gravity of the vehicle with respect to the road surface, 
but measured along the body z-axis. 



[0041] Referring now to Figure 3, the four equations 
of Equation (3) pose four constraints on a set of seven 
variables: ^,^,2* , ^ , z ea , 9^ and 6^. Hence a combination 

of three variables can be used to compute the rest of 
the variables. Since 6^ and 9 yljr are of interest in the 

present invention, the possible choices are choosing 
three variables from z ls ,z r!t z w , z^. and z C!) to characterize 
6 Itn . and 6 vln . . The direct measurement of any of z lr z,. r z b . , z n . 
and z C!) is relatively expensive (for example, expensive 
laser distance sensors can be used) . Hence, measuring 
any three of z lf ,z r/ ,z [r , z^ and z^ may be cost prohibitive in 
a commercial environment with current technology. 
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However, certain linear combinations of the four corner 
and . z„ can be related to the 



displacements 

available sensors through dynamics. When linear 

combinations are related to the relative roll and pitch 
Euler angles 8 xbr and d ybr , 0 sbr and may be characterized 
from the available sensor signals. In the following, 
the effort has been focused on finding those linear 
combinations of z, r z^,z lr . z^ , which bridges between and 
9 and the available sensor signals including the 
lateral and longitudinal accelerations, the roll and yaw 
angular rates and the wheel speed sensor signals. 

The Relative Attitudes Based On The Linear Combinations 
Of The Corner Displacements 

[0042] The linear combinations of « r V 2 * < < which 

serve as bridges to connect $ rJ/r and 9 lM with the 

available sensor signals are the following variables, 

which are called the relative roll and pitch gradients 



" ~ " ^ , V 

(4) 



2(tj + U) 



Q t and e„ is related to the relative roll and pitch 
attitudes by manipulating the equations in (3). The 
final formula for the relative pitch Euler angle is 

9^ = sin-He,} (5) 

and the final formula for the relative . roll Euler angle 
6., is 
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(6) 



[0043] 



On the other hand @ t and 0„ can be further 



related to the available sensor signals through dynamic 
equations which describe the vehicle body dynamics. 
and 0„ will be first broken into two portions, and 
related to the sensor signals. 

Roll And Pitch Gradients Due To Suspension And Wheel 
Motions 

[0044] As shown in Figure 4, a portion of the left 
front wheel 12b and suspension 52 are illustrated, z (I 
can be further expressed as the sum of the two parts: 
the suspension stroke s lf as measured by sensor 5 0 and the 
wheel displacement w tf vith respect to the road surface 
along the direction perpendicular to the road surface. 
The same is true for the rest of the corner locations. 
The sensor 50 may measures the change in the distance 
from the vehicle body to the wheel. If the four 
suspension strokes are i^.^.^and a rr , and the four wheel 
vertical motions are u^.w^.w^and then: 



G„ may be broken into pieces according to the suspension 



z v = s v + w f/ 

z lr ~ S lr + W tr 
Z rr =3 n .+ Wrr 



(7) 



[0045] 



The relative roll and pitch gradients 6,. and 
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motion and the wheel vertical motion. The roll and the 
pitch gradients e x . aMp and 0 w _ JIiap due to suspension motions 
s (/1 s r/ ,s h . and may be defined as: 

_ a v + * H " y - Kr 

and the roll and pitch gradients & X _, M and e ;i _ llM due to 
the wheel vertical motion defined as: 



Then 




(9) 



(10) 



[0046] The relative Euler angles 6 xlir &nd 0, /(ir can be also 

written as two parts: 



6 V br = ^"'{©.-IWP + Q v -«iu} 




(11) 



[0047] Since there are no restrictions in Equation 
(ll) , it is valid regardless of if the four wheels of 
the vehicle contact the road surface or lift from the 
road, as soon as the accurate characterization of the 
roll and pitch gradients e,..^ and @ v - m ^ , and © x _,„, w and 
e i/-u>w are available. Hence in the following 
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© K -.,uv / Q u -«. w . ©x-ww and ma y be computed baaed on the 

available sensor signals. 

Estimate The Roll And Pitch Gradients 
[00481 From the formula in Equation (8) , the roll and 
pitch gradients e,.^ and ©„_^ are related co the 
suspension stroke. The estimation schemes are sought 
for computing and e„_ SU4 „ from the available sensor 

signals . 

[0049] Consider in Equation (3) that the distance 

differences between the left side corners and right side 
corners are equal, that is: 



= : lT -z rr (12) 



Since the tire deflections are much smaller than the 
suspension stroke, from (13) it is reasonable to say 

or rewrite this as: 

(15) 

Hence, for any given constant weight k , we have: 
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In the sequential discussion, the Equation (16) may be 
used to describe the roll gradient 6^,,,, . 

[0050] 6,.^ and & v -wv roust then be related to the 

available sensor signals. The following dynamic 

relationship which are obeyed by the car body through 
the Newton law described around the e.g. of the vehicle 
body 

= + W/ S <r + D A> " + W + + D '*tr) ' + °^-) 




«A = XX 

i=t 

(17) 

where 7* and /„ are the momentum of inertia of the car 
body with respect to the x and y axis respectively; M, 
is the sprung mass (the mass of the car body) ; k, is the 
e.g. height of the car body with respect to the top of 
the suspension; K f and K r are the front and rear 
suspension spring rates with unit N/m. K , mU -n,u-i anc * 
K a,ui-nu- T are the stiffnesses for the front and the rear 
anti-roll bar, with unit Nmlrad . Dj and £>, are the 
front and the rear suspension damper rates; F Mi is the 
ith suspension force applied to the car body along the 
body fixed direction 6, , and F vi is the ith suspension 
force applied to the car body along the body fixed 
direction b 2 . 
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Define a weight 



(18) 



Since the damping rates are usually proportional to the 
spring rates for suspensions, it is reasonable to 
assume : 



For a well balanced vehicle, the normal dead loading 
applied to the vehicle should not generate significant 
body attitude variation when the vehicle is parked on a 
flat road. That is, the roll and pitch attitude angles 
induced by the normal dead loading during flat road 
parking should be close to zero. For this reason, it is 
reasonable to assume the following holds: 

t,.K r =t f K f (20) 

Similar argument can be used for suspension damping 
rates . 

[0051] Through algebraic manipulation the first two 
equations in Equation (17) can be rewritten as the 
following: 




(19) 
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= + «,#,(«<, + - v - + t,D,(A tf + a r/ - ifc. - i,r) 



(21) 



Using the definition of e,_^ and ©„_„„,,, Equation (21) 



can be rewritten as: 



(22) 



that is, ©,_^(t) and e„.^(<) obeys the 1 st order 
differential equations, and the coefficients £.•,,,£.,.<;,. 4,, 4 
and can be obtained by comparing Equation (21) and 
Equation (22) . Although the analytical solution for 
Equation (22) are not hard to find, the solutions may be 
directly implemented in digital environment . On the 
other hand, the pitch rate signal is not measured, but 
an estimation of the pitch rate signal can be obtained 
as a function of the measured signals and the signals 
computed from the measured signals: 



where 6 X and 0 V are the estimated global roll and pitch 
Euler angles of the vehicle body (with respect to the 
sea level). The details if this are described in U.S. 
Application 09/967,938 which is incorporated by 



signal, (22) can be used to solve for ©..,„,, w ,(t) and e,_,,^,(«) 
at time instant t. In the following a digital scheme 



Q y = 4 seo(flL ) + u> z tan(4 ) (23) 



reference herein. 



Using the estimated pitch rate 
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will be summarized. Two variables as defined at each 
sampling instant: 

RRA_RAW(k) = -c^(fc) - Jo, (A) 

* 2 (24) 

Then at the (k+l)th sampling instant (current values), 
the estimates of the roll and pitch gradients + 1) 

and §„_,„,,,(*: + 1) may be computed from their values in the 
kth sampling instant (past values) and the current and 
past values of RRA_RAW and RPA_RAW . The iterative 
formula may be expressed as the following with properly 
chosen coefficients «^,c,,/ 0 and : 

© x p (* + 1) = ^-^(k) + e,[RRA^RA VV(k + 1) + RRA_RA W(k)) 

6 f -«,(* + 1) = f D Q m M + f i [RPA_RA W(k + 1) + RPA_RA W(k)\ 

[0 052] The wheel motion- induced roll and pitch 
gradients are usually much smaller than the suspension 
motion induced gradients due to the small tire 
deflections at each wheel/tire assembly. Therefore: 



© v -™« « ©»-««p 



(26) 



or say : 




©a 



(27) 
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